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CLAIMS: ... 
This listing of claims will replace all prior versions, and listings, of claims ,n the 

application: 

1 . (Original) A method of detecting obstacles comprising: 

producing a depth map of a scene containing terrain; and 

processing the depth map to identify regions that do not exceed a mobility 

constraint for a vehicle, and regions that do exceed the mobility constraint of the 

vehicle. 

2. (Original) The method of claim 1 wherein the processing step includes processing 
data in the depth map to determine a height change of the terrain over a distance 
represented by pixels in the depth map. 

3. (Original) The method of claim 1 wherein the processing step further comprises: 

computing an amount by which the mobility constraint is exceeded in a region. 

4. (Original) The method of claim 3 wherein step of computing the amount by which the 
mobility constraint is exceeded further comprises computing a non-drivable residual. 

5. (Original) The method of claim 4 wherein the non-drivable residual represents 
positive or negative elevations beyond limits computed from slope constraints. 

6. (Original) The method of claim 1 wherein the depth map is a smoothed depth map. 

7. (Original) The method of claim 6 further comprising: 

dividing the depth map into blocks of pixels; 
fitting a plane to each of the blocks of pixels; and 

identifying a point in the center of each plane as points that form the smoothed 
depth map. 

8. (Original) The method of claim 6 further comprising: 
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identifying a current point (X.Y.Z) representing a current location wtthin the depth 

map; , 
subtracting a last point (X,Y,Z)l. which represents a last location within the depth 

map, from the current point to derive a displacement (AX, AY, AZ); 

computing a distance traveled (d L ) between the last point and the current point; 

providing a maximum slope (s di ) for a drivable incline; 

determining uphill and downhill limiting values (AY^ =-s„^ L and 
Ar = s d Hor a drivable vertical displacement AY by multiplying the maximum 

downhill *di**L' 

slope by the distance traveled; 

if the vertical displacement AY is less than the limiting values, the terrain within 

the distance traveled is determined to be drivable; 

if the vertical displacement AY is greater than the limiting values, the terrain 
within the distance traveled is determined to contain a potential obstacle; and 

if a potential obstacle is detected, computing a non-drivable residual to determine 
whether the potential obstacle is an obstacle. 

9. (Original) The method of claim 4 wherein the step of computing the non-drivable 
residual comprises: 

identifying a prior location in the depth map that does not contain an obstacle as 

a last good point (X,Y,Z)g; 

computing a second distance traveled (d 0 ) from the last good point to the current 

point (X.Y.Z); 

computing a residual limiting value (A7^ =-s 4i d a and AY^,,, = s di d a ) for the 
residual (AR nd ) by multiplying the maximum slope with the second distance traveled; 
and 

computing the residual as: 

AY C - &Y Jowlim , Ay^a, < AY G 

0 AY aphm £ AY a <. AY^^at 

AY g - AY^ AY C <AY^ 
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if the residua, is greater than a predefined threshold, then the potential obstacie is an 
obstacle; 

updating the last point with the current point; and 

if the residual is zero, then updating the last good point with the current point 

10. (Original) Apparatus for detecting obstacles comprising: 

a stereo image processor for producing stereo imagery of a scene containing 

terrain; 

a depth map generator for processing the stereo imagery and producing a depth 
map; and 

a depth map processor for processing the depth map to identify regions that do 
not exceed a mobility constraint for a vehicle, and regions that do exceed the mobility 
constraint of the vehicle. 

11. (Original) The apparatus of claim 10 wherein the depth map processor further 
comprises: 

means for computing an amount by which the mobility constraint is exceeded in a 

region. 

12. (Original) The apparatus of claim 10 wherein the depth map is a smoothed depth 
map. 

13. (Original) The apparatus of daim 12 further comprising: 

means for dividing the depth map into blocks of pixels; 

means for fitting a plane to each of the blocks of pixels; and 

means for Identifying a point in the center of each plane as points that form the 

smoothed depth map. 

14 (Original) The apparatus of claim 10 wherein the depth map processor comprises: 

means for processing each column of data In the depth map to determine the 
height change of the terrain over the distance represented by pixels in the depth map. 
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15. (Original) The apparatus of claim 14 wherein the depth map processor comprises 
means for computing a non-drivable residual. 

16. (Original) The apparatus of claim 15 wherein the non-drivable residual represents 
the positive or negative elevations beyond limits computed from slope considerations. 

17. (Original) The apparatus of claim 10 further comprising: 

means for identifying a current point (X,Y,Z) representing a current location within 

the data; 

means for subtracting a last point (X,Y,Z) L representing a last location within the 
data from the current point to derive a displacement (AX, AY, AZ); 

means for computing a distance traveled (d L ) between the last point and the 

current point; 

means for providing a maximum slope (Sdi) for a drivable incline; 
means for determining uphill and downhill limiting values ( =-s„,d L and 
AY dmmhiU = sji L ) for a drivable vertical displacement AY by multiplying the maximum 

slope by the distance traveled; 

if the vertical displacement AY is less than the limiting values, the terrain within 

the distance traveled is determined to be drivable; 

if the vertical displacement AY is greater than the limiting values, the terrain 
within the distance traveled is determined to contain a potential obstacle; and 

if a potential obstacle is detected, the depth map processor computes a non- 
drivable residual to determine whether the potential obstacle is an obstacle. 

18. (Original) The apparatus of claim 15 wherein the depth map processor further 
comprises: 

means for identifying a good point (X,Y,Z)g as a prior location that does not 
contain an obstacle; 

means for computing a second distance traveled (d G ) from the last good point to 
the current point (X,Y,Z); 
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means for computing a residual limiting value (AJ^ =-*<A and 
a y = 5 , 4c ) for the residual (R n d) by multiplying the maximum slope with the second 

distance traveled; and 

means for computing the residual as: 

Ale - » Ay i4»«»(w < Ay <? , 

0 AT^. 4 AT, S if the residual is greater than a 

Ar G - Ar^a, Ar c < af^ 

predefined threshold, then the potential obstacle is an obstacle. 

19. (Original) An obstacle detecting system comprising: 

a vehicle having a movement system for moving the vehicle across a terrain; 
a stereo image processor mounted to the vehicle, the stereo image processor for 
producing stereo imagery of a scene containing the terrain; 

a depth map generator for processing the stereo imagery and producing a depth 

map; and 

a depth map processor for processing the depth map to identify regions that do 
not exceed a mobility constraint for the vehicle, and regions that do exceed the mobility 
constraint of the vehicle. 

20. (Original) The obstacle detecting system of claim 19 further including: 

an obstacle detector responsive to the depth map processor, the obstacle 
detector for identifying an obstacle in the path of the vehicle that exceeds the mobility 
constraint of the vehicle; and 

a control system that controls the movement system so as to move the vehicle 

around the identified obstacle. 

21. (Original) The obstacle detecting system of claim 19 further including: 

an obstacle detector responsive to the depth map processor, the obstacle 
detector for identifying an obstacle in the path of the vehicle that exceeds the mobility 
constraint of the vehicle; and 
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a warning system that signals when an obstacle in the path of the vehicle is 
Identified. 

22 (Original) The obstacle detecting system of claim 19 wherein the depth map 
processor includes means for computing an amount by which the mobility constraint is 
exceeded In a region, and wherein the depth map is a smoothed depth map. 

23. (Original) The obstacle detecting system of claim 22 further comprising: 

means for dividing the depth map into blocks of pixels; 

means for fitting a plane to each of the blocks of pixels; and 

means for identifying a point in the center of each plane as points that fonm the 

smoothed depth map. 

24. (Original) The obstacle detecting system of claim 19 wherein the depth map 
processor includes means for processing each column of data in the depth map to 
determine the height change of the terrain over the distance represented by pixels in the 
depth map, and means for computing a non-drivable residual that represents the 
positive or negative elevations beyond limits computed from slope considerations. 

25. (Original) The obstacle detecting system of claim 19 further comprising: 

means for identifying a current point (X.Y.Z) representing a current location within 

the data; 

means for subtracting a last point (X,Y,Z)l representing a last location within the 
data from the current point to derive a displacement (AX, AY, AZ); 

means for computing a distance traveled (d L ) between the last point and the 

current point; 

means for providing a maximum slope (s^) for a drivable incline; 
means for determining uphill and downhill limiting values {AY UfMU =Vi and 
\Y =s d ) for a drivable vertical displacement AY by multiplying the maximum 

downhill di £ * 

slope by the distance traveled; 
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if the vertical displacement AY Is less than the limiting values, the terrain within 
the distance traveled is determined to be drivable; 

if the vertical displacement AY is greater than the limiting values, the terram 
within the distance traveled is determined to contain a potential obstacle; and 

if a potential obstacle is detected, the depth map processor computes a non- 
drivable residual to determine whether the potential obstacle is an obstacle. 

26. (Original) The obstacle detecting system of claim 19 wherein the depth map 

processor further comprises: 

means for identifying a good point (X,Y,Z) G as a prior location that does not 

contain an obstacle; 

means for computing a second distance traveled (d 6 ) from the last good point to 

the current point (X.Y.Z); 

means for computing a residual limiting value (AJ^ =Vc and 
AY , = s M d c ) for the residual (FU by multiplying the maximum slope with the second 

1 -* x downhill .m C * 

m 

distance traveled; and 

means for computing the residual as: 

r AY a - AY immhia > Ar^u < Ar 0 

0 Al^, < AY G * AI^ if the residual is greater than a 

^ AY G - AY^ Ay c < AY vm 

predefined threshold, then the potential obstacle is an obstacle. 
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